#include <Arduino.h>
#include "cs100.h"
 
// 引脚模式设置
void cs100_init(void)
{
    pinMode(TRIGGER_PIN, OUTPUT);
    pinMode(MY_ECHO_PIN, INPUT);
}
 
// 距离值计算返回函数
float calculate_distance(void)
{
    // 发送触发信号
    digitalWrite(MY_ECHO_PIN, LOW);
    delayMicroseconds(2);
    digitalWrite(TRIGGER_PIN, HIGH);
    delayMicroseconds(20);
    delayMicroseconds(2);

    long duration = pulseIn(MY_ECHO_PIN, HIGH, PULSE_TIMEOUT);
    Serial.print("duration:");
    Serial.println(duration);
    
    // 将回响时间转换为距离（单位：厘米）
    float distance = duration * 0.034 / 2;
    return distance;
}